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[57] ABSTRACT 

An underwater navigation and controi system for a swim- 
ming pool cleaning robot, having a driver, an impeller, a 
filter and a processor for conUxilling the driver and a 
signal-producing circuit The system fiirther includes a sig- 
nal-detecting circuit mounted on the pool, an interface 
located on the ground in proximity to the pool and com- 
prising a detector for receiving and processing data from the 
detecting circuit and for transmitting signals to the robot's 
processor. Determination of the actual robot location is 
performed by triangulation in which the stationary triangu- 
lation base is defined by at least two spaced-apait signal 
detectors and the mobile triangle apex is constituted by the 
signal-producing circuit carried by the robot 

15 Claims, 9 Drawing Sheets 
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Fig.3. 
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SYSTEM FOR UNDERWATER NAVIGATION 
AND CONTROL OF MOBTLE SWIMMING 
POOL FILTER 

The preseni invention relates to an underwater navigation 5 
and control system for a pool-cleaning robot. It relates also 
to a method for carrying out such navigation and control of 
a pool-cleaning robot 

Pool-cleaning robots are known, an example being the 
commercially available, self-propelled "Dolphin'*'', suitable lo 
for swimming pools of a size of up to 25x20 m. Cleaning is 
based on the statistical probability that the device, crawling 
along the pool floor, guided by a random algorithm, will 
eventually cover the entire floor area. Because of the proba- 
bilistic nature of the concept, the cleaning of a relatively 15 
small pool of the above size will take up to 12 hours. While 
this may not be a serious disadvantage for those small, 
mainly private pools which can afford to be inoperative for 
such a long period of time, it is totally inaccepiable for large 
(50x40 m) public swimming pools, which operate continu- 20 
ously for 16 hours, 7 days a week. 

It is thus one of the objects of the present invention to 
provide a system employing a pool-cleaning robot that 
operates according to a non-statistical principle, being navi- 
gated along a predetermined path adapted to the speciiic 25 
dimensions and shape of a given pool and that will therefore 
be capable of cleaning large-size swimming pools in the few 
hours per day during which these pools are inoperative. 

According to the invention, the above object is achieved 
by providing an underwater navigation and control system 20 
for a swimming pool cleaning robot, comprising locomotion 
means for said robot, adapted to produce a steerable motion 
thereof; impeller means for drawing solids-entraining water 
from the floor of said pool through filter means, and return- 
ing said water after Altering to said pool; microprocessor 35 
means to control said locomotion means to the e£fect of 
causing said robot to follow a preprogranmied route, and to 
generate correction signals whenever, at a given instant, the 
actual location of said robot deviates from the location as 
prescribed, for that instant, by said preprogranuned route; a 4o 
signal-producing means carried by said robot; at least two 
signal-detecting means fixedly mounted in spaced-apart 
relationship at, or in close proximity to, at least one side of 
said pool and being acted upon by said signal-producing 
means; interconnection means located on the groimd in 45 
proximity to said pool and comprising a detector processing 
logic to receive and process data from said detecting means 
for transmission to said robot microprocessor means, 
wherein determination of said actual robot location is per- 
formed by triangulation in which the stationary triangulaiion 50 
base is defined by said at least two spaced-apart signal- 
detecting means and the mobile triangle apex is constimtcd 
by said signal-producing means carried by said robot. 

There is also provided a method for controlling the 
underwater navigation of a pool-cleaning robot, comprising 35 
the steps of providing a stccrabic, clcctrically-drivcn pool- 
cleaning robot equipped with at least one on-boand micro- 
processor having at least one memory; preparing, according 
to the dimensions of said pool, a map of the route to be taken 
by said robot for substantially covering the entire pool; 60 
converting said map into a plurality of coordinates; entering 
said coordinates into said memory; determining the actual 
instantaneous position of said robot in said pool by trian- 
gulation, in which the apex of the triangulation triangle is a 
signal-producing means carried by said robot, and the sta- 65 
tionary triangulation base is defined by at least two signal- 
detecting means fixedly mounted in spaced-apart relation- 



ship at at least one side of said pool and exposed to said 
signal-producing means; comparing the actual position of 
said robot as determined by triangulation with the robot 
position as prescribed for the same instant by said route map, 
and, based on the difference between the actual and the 
prescribed positions of said robot, producing signals to 
correct said actual position. 

The invention will now be described in connection with 
certain preferred embodiments with reference to the follow- 
ing illustrative figures so that it may be more fully under- 
stood. 

With specific reference now to the figures in detail, it is 
stressed that the particulars shown arc by way of example 
and for purposes of illustrative discussion of the preferred 
embodiments of the present invention only, and are pre- 
sented in the cause of providing what is believed to be the 
most useful and readily understood description of the prin- 
ciples and conceptual aspects of the invention. In this regard, 
no attempt is made to show structural details of the invention 
in more detail than is necessary for a fundamental under- 
standing of the invention, the description taken with the 
drawings making apparent to those skilled in the art how the 
several forms of the invention may be embodied in practice. 

In the drawings: 

FIG. 1 is a schematic elevational view of the robot used 
in the system according to the invention; 

FIG. 2 is an equally schematic top view, showing only 
the undercarriage of the robot; 

FIG. 3 shows a typical route map along which the robot 
travels, covering the pool's entire floor area; 

FIG. 4 represents the layout and components of a first 
embodiment of the system according to the invention; 

FIG, 5 illustrates the layout and components of a second 
embodiment of the system; 

FIG. 6 shows the layout and components of a third 
embodiment of the system; 

FIG. 7 is a schematic representation of the light collector 
for the embodiment of FIG. 6; 

FIG. 8 shows the layout and components of a fourth 
embodiment of the system; 

FIG. 9 is a schematic representation of the wheeled 
caddy that carries the robot as well as several units of the "on 
shore" equipment; 

FIG. 10 is a block diagram of the navigation control logic 
of the embodiment of FIG. 5, and 

RG. 11 is a block diagram of the entire system as 
exemplified in the embodiment of FIG. 5. 

Referring now to the drawings, there arc seen in FIGS. 1 
and 2 schematically simplified views of the per se known 
robot used in the system according to the invention. 

Locomotion of the robot along and across the pool floor 
is effected by two pairs of plastic traction brushes 2 and 4, 
each pair independently driven by its own electric motor 6 
and 8, respectively. Power is transmitted by non-slipping 
dming belts 10 and steering is effected by varying the 
relative speeds of motors 6 and 8. 

Further seen in RG. 1 is a box 12 accommodating an 
electric motor (not shown) driving an impeller 14 which 
draws the pool water carrying the solid deposits by way of 
a slot 16 in the bottom of box 12 through a filter bag (not 
shown) and expels the filtered water through an aperture 18 
in the top of housing 20. Power and signals arc fed to the 
robot via an umbilical cable 22 leading to an interconunu- 
nication box (see FIG. 10) located at one of the pool sides 
and advantageously mounted on a caddy or trolley on which 
the robot is transported to and from the pool. 

Further accommodated in the robot is the electronic 
circuitry in the form of a microprocessor, to be discussed 
further below. 
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Navigation of ihe robot is based on "teaching" the robot 
in a data acquisition mode the route programmed for a 
specific pooK monitoring execution of that route and cor- 
recting any deviations from that route. To this end, it must 
be possible to determine the instantaneous location of the 5 
robot within the pool in terms of x»y-coordinates, which is 
done by means of iriangulation. The base of the triangulation 
triangles is the known and fixed distance between two 
stationary elements positioned at the pool sides and serving 
either as signal sources or as signal receivers, and the apex 
is the robot itself. 

FIG. 3 shows a pool map, illustrating a possible route to 
be taken by the robot in order to fully cover the pool floor, 
with the pool P outlined in bold. It is seen thai the robot 
proceeds along a path generally spiralling inwards, starling 
from coordinates 0.0. However, having completed the first 
turn of the spiral, say, in the clockwise sense, the robot 
moves inwards for the pitch distance of the spiral (about 50 
cm) and travels along the second turn in the counterclock- 
wise sense, reversing the sense of travel for each successive 
turn. This strategy is devised to prevent excessive twisting of 20 
the umbilical cable 22. 

FIG. 4 shows a first embodiment of the arrangement for 
triangulation. based on ultrasonic range detection. The robot 
carries a generator 24 producing an ultrasonic "ping" every 
5 sec. At the side of the pool P there are disposed two 25 
hydrophones 26, 26* at a mutual distance L, which consti- 
tutes the kn own tr iang ulation base. Hie other two sides of 
the triangle. 26,24 and 26',24, are automatically calculated 
as a function of the time it takes the sound from the generator 
24 to reach each one of the hydrophones 26, 26* and permit 30 
determination of the instantaneous robot location. Via an 
interconnection box 28, the data from the hydrophones 26. 
26' are transferred to the on-board microprocessor over the 
umbilical cable 22, to compare the actual robot location with 
the locadon as determined by the predetermined program 35 
and to effect a positional correction, if such be necessary. 

no. 5 represents an electro-optical solution of the tri- 
angulation problem. There arc seen two rotatabic, direction- 
sensitive light detectors 30. 30' sealingly mounted in trans- 
parent acrylic cylinders and immersed in the water at a 40 
mutual distance of L, adjacent to a pool side. Each one of 
detectors 30, 30' is mechanically coupled with a high- 
resolution shaft encoder (not shown) coaxial with, and 
driven by, an electric motor rotating advantageously at a rate 
of 60 rpm. A modulated nondirecUonal light source 32 Is 45 
mounted inside an acrylic dome on top of the robot. A 
maximum signal at detectors 30, 30' indicates that the 
respective detector is pointing directly at light source 32. at 
which instant the angle is read off the shaft encoder of each 
detector, yielding the base angles a and p which, together 50 
with the base L, permit the determination of the robot 
location and, as in the previous embodiment, correction of 
that location if required. The output signals of detectors 30, 
30* as well as the reading of the shaft encoders are fed via 
the interconnection box 28 and the umbilical cable 22 to the 55 
on-board microprocessor of the robot. 

Another electro-optical triangulation arrangement is 
illustrated in FIG. 6. There, the iriangulation base is defined 
by two stationary light detectors 34, 34'. A highly direc- 
tional, rotatable light source 36, such as a laser transmiiier, 60 
is mounted under a transparent acrylic dome on lop of the 
robot and is mechanically coupled with an electric motor 
coaxial with a high-resolution shaft encoder, A maximum 
signal is produced by detectors 34, 34' when hit by the beam 
from the rotating light source 36. This, with the aid of the 65 
shaft encoder, facilitates the determination of angles a and 

and thus of the actual location of the robot. 
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However, as the difference in height between the pool 
edge and the light source 36 varies due to the slope of the 
pool floor, means must be provided to ensure that the 
rotating laser beam will always hit the detectors 34, 34', even 
when the robot is at the deeper section of the pool. 

The solution to this problem is represented in FIG. 7. 
There is seen a light-collector rod 38 made of a transparent 
plastic material, carrying a transmission grating 40, behind 
which is arranged a reflector 42. In dependence on the given 
wavelength of the light source 36, grating 40 is configured 
to maximize first-order beams and minimize zero and other 
order beams. 

As seen in FIG. 7, a light ray B from source 36 which hits 
grating 40 at an angle of incidence of about 0** is diffracted, 
producing a first-order beam that hits reflector 42 at an angle 
of incidence of about 30°, is then reflected, and arrives at 
grating 40 (from the rear) at the same angle of incidence. 
Passing through grating 40 to be again diffraaed. it arrives 
at the opposite wall of rod 38 at an angle of incidence of 
about 60° which, given the indices of refraction of the media 
involved (N„^1.5; N^awi-=l-33)' is beyond the critical 
angle, producing total internal reflexion that confines the 
beam inside rod 38 and carries it upwards until it hits 
detector 34. Rod 38 must, of course, be long enough to 
intercept the beam also from the deepest positions of the 
beam. Head 44 accommodates a preamplifier to be con- 
nected to the interconnection box 28 (FIG. 6). 

Yet another embodiment of the triangulation concept of 
the system according to the invention is illustrated in FIG. 
8. There is seen, mounted under a transparent acrylic dome 
on top of the robot, a rotatable, highly direction-sensitive 
light detector 46 mechanically coupled with a high-resolu- 
tion shaft encoder (not shown) driven by an electric motor. 
There are fiirther provided four nondirectional light sources 
in the form of high-intensity infrared transmitters 48, 50, 52 
and 54, attached below water level to one each of the pool 
walls, substandally at the center of the pool length and the 
pool width, thus dividing the pool into four quadrants I, H, 
ID, IV. Each light source is modulated at a different fre- 
quency, enabling die robot to determine immediately in 
which quadrant it is moving, the two sources of that par- 
ticular quadrant defining the instantaneous base for triangu- 
lation. At maximum stimulation of detector 46, the angle is 
read off the shaft encoder and the robot location is deter- 
mined by triangulation. This embodiment is particularly 
suitable for very large swimming pools, as the large area is 
subdivided into smaller "cells," enhancing navigation accu- 
racy. 

FIG. 9 schematically represents the wheeled caddy on 
which the robot is transported between, say, a storeroom and 
the pool. Also accommodated on the caddy arc the already- 
mentioned intcrcoimcction box 28. which carries a trans- 
former module 56 that, over an umbilical cable 22, supplies 
electric power to the robot and its electronic circuitry; a 
light-detector processing logic 60 for processing signals 
from the pool-side detectors such as detectors 30, 30' of FIG. 
5; an ovcr-the-power-line modem 62 for transmitting the 
processed data over the umbilical cable 22 to the on-board 
microprocessor of the robot, and a wireless receiver 64 with 
an aerial 66. With the aid of a manual remote-control unit 
which overrides the automatic system, the robot can be 
manually controlled when, for instance, the system breaks 
down. U is also possible to walk the robot around Ihe pool, 
using the above wireless control, to teach its navigation 
prtx:essor, in a data acquisition mode of the latter, the 
intended route. Cables 68 lead to the detectors 30, 30* at the 
pool wall, while cable 70 connects the caddy to the mains. 
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The umbilical cable 22 is provided with a plurality of 
appropriately spaced floats 72. 

FIG. 10 is a block diagram representing the navigation 
control logic of such ah embodiment as illustrated in FIG. 5. 
There are seen light detector 30 as coupled to shaft encoder 5 
74 and light detector 30' as coupled to shaft encoder 76. The 
base angles a and P at any instant are determined in encoder 
readers 78, 80, and the instantaneous position of the triangle 
apex, i.e., of the robot, is calculated in position resolver 82. 
The resolved data are transferred to error calculation logic 
84 which also generates an appropriate correction signal to 
the motor control system, which can either speed up or slow 
down the traaion motors 6 and 8, or can deflect the robot by 
driving each of the pairs of traction brushes 2 and 4 at a 
different speed or even in a different sense. 

FIG. 11 is a block diagram of the entire system as 
exemplified in the embodiment of FIG. 5. There is seen the 
interconnection box 28 with its units as explained in con- 
junction with FIG. 9, as well as the hand-held, joystick- 
operated manual remote control 86. The umbilical cable 22 
leads to an overvoltage protection unit 88, a rectifier 90 and 20 
a regulator unit 92, providing power to motors 6 and 8, and, 
via the motor and hardware control processor 84, also to ttie 
impeller motor 96. 

Also connected to umbilical cable 22 is the receiving 
over-the-power-line modem 98 which feeds the raw navi- 25 
gation data generated in interconnection box 28 to motor and 
hardware processor 96 and navigation processor 98. Other 
inputs of processor 96 are listed at its left Sensors at its right 
include an RPM sensor of impellw motor 94, a position 
sensor (in the form of a mercury switch) which responds 
when the robot dangerously tiJts, a water sensor responsive 
to water break-in, and a temperature sensor. Processor 96 is 
also equipped with a parallel flash memory 100. 

Navigation processor 98 is fed the triangulation data and 
produces correction signals if correction is required. Pro- 
cessor 98 is equipped with a static ROM 102. 

Also seen is nondirectional light source 32. Light detec- 
tors 30, 30' are driven by gear motors 104. The output of 
detectors 30, 30^ is tapped off by slip rings 106. 

Qeaning according to the route map of FIG. 3 starts at 
coordinates 0,0 along the first track. Travelling speed is 
preset and can only be affected by excesssive slipping. Each 
10 cm or less, locating coordinates are provided by the 
triangulation system. These coordinates are compared to 
route map coordinates originally read into the processor 
memory. Any difference between the coordinates will be 
translated into directions correction data and fed into the 
motor control processor. 

It will be evident to those skilled in the art that the 
invention is not limited to the details of the foregoing 
illustrated embodiments and that the present invention may ^ 
be embodied in other specific forms without departing from 
the spirit or essential attributes thereof. The present embodi- 
ments are therefore to be considered in all respects as 
illusu^tive and not restrictive, the scope of the invention 
being indicated by the appended claims rather than by the 
foregoing description, and all changes which come within 
the meaning and range of equivalency of the claims are 
therefore intended to be embraced therein. 

What is claimed is: 

1. A swimming pool cleaning, navigational controlled 
system, comprising: 
a robot; 

locomotion means for said robot for producing a steerable 
motion therefor; 65 

impeller means, movable with said robot, for drawing 
solids-entraining water from the floor of said pool 
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through filter means for filtering the solids-entraining 
water, the filter means being mounted adjacent to. and 
upstream of, said impeller means, and returning said 
water after filtering to said pool; 

microprocessor means associated with said robot for 
controlling said locomotion means for causing said 
robot to follow a preprogrammed route, and to generate 
correction signals whenever, at a given instant, the 
acmal location of said robot deviates from said prepro- 
granuned route; 

signal-producing means carried by said robot; 

at least two signal-detecting means defining together with 
said signal producing means a stationary, triangulation 
base and being fixedly mounted in spaced-apart rela- 
tionship at. or in close proximity to each other, on at 
least one side of said pool and being acted upon by said 
signal-producing means; 

a mobile triangle apex being defined by said signal- 
producing means together with said signal detecting 
means; and 

coupling means located on the ground in proximity to said 
pool and comprising a detector processing logic to 
receive and process data from said detecting means for 
transmission to said microprocessor means; 

wherein the actual robot location is determined by trian- 
gulation of said stationary triangulation base defined by 
said at least two spaced-apan signal-detecting means 
and the mobile triangle apex. 

2. The system as claimed in claim 1 wherein said coupling 
means includes an umbilical cable for coupling said trans- 
mission means with said robot, as well as for transmitting, 
by. means of ovcr-the-power-lincs modems, said processed 
data to said microprocessor. 

3. The system as claimed in claim 1 wherein said coupling 
means includes a transformer unit to supply power to said 
robot and said microprocessor means, as well as to said 
signal-producing and detecting means. 

4. The system as claimed in claim 1, wherein said 
signal-producing means is an ultrasound generator carried 
by said robot and said signal-detecting means are hydro- 
phones disposed at one of the sides of said pool. 

5. The system as claimed in claim 1, wherein said 
signal-producing means is a water-inmiersible, nondirec- 
tional light source carried by said robot. 

6. TTie system as claimed in claim 1, wherein said 
signal -detecting means are water-inmiersible, direction-sen- 
sitive light detectors, each mechanically coupled to a shaft 
encoder, each encoder adapted to be rotated by an electric 
motor. 

7. The system as claimed in claim 1, wherein said 
signal-producing means is a water-immersible, directional 
light source mounted on said robot and mechanically 
coupled to a shaft encoder adapted to be rotated by an 
electric motor. 

8. The system as claimed in claim 1, wherein said 
signal-detecting means are two stationary light deteaors, 
each mounted in an elongated, transparent, substantially 
vertically immersed light-collector rod, each rod carrying an 
axiaUy-disposed transmission grating behind which is 
arranged a reflecting surface, to the effect that a light ray 
impacting said grating at a small angle of incidence is made 
to impact, from the inside thereof, die wall of said rod at an 
angle of incidence larger than the critical angle, thus pro- 
ducing total internal reflection that carries said beam 
upwards to meet said light detector. 

9. The system as claimed in claim 1, wherein said 
coupling means includes a wireless receiver addressable by 
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a hand-held wireless remoie control unit for manually con- 
trolling said robot. 

10. A swimming pool cleaning, navigational controlled 
system, comprising: 

a robot; 5 

locomotion means for said robot capable of producing a 
stcerable motion therefor; 

impeller means, movable with said robot, for drawing 
solids-entraining water from the floor of said pool jq 
through filter means for filtering the water, the filter 
means being mounled adjacent to, and upstream of, 
said impeller means, and returning said water after 
filtering to said pool; 

microprocessor means provided in said robot for control- 15 
ling said locomotion means for causing said robot to 
follow a preprogrammed route, and to generate correc- 
tion signals whenever, ar a given instant, the actual 
location of said robot deviates from said prepro- 
granuned route; 20 

signal-detecting means carried by said robot; 

at least two signal-producing means, together with said 
signal delecting means defining a stationary triangula- 
tion base, being fixedly mounted in spaced-apart rela- 
tionship at, or in close proximity to each other, on at 25 
least one side of said pool and acting on said signal- 
detecting means; 

a mobile triangle apex being defined by said signal- 
detecting means together with said signal producing 
means; and 

transmission means located on the groimd in proximity to 
said pool and comprising a detector processing logic to 



30 



receive and process data from said detecting means for 
transmission to said microprocessor means; 
wherein the actual location of said robot is determined by 
triangulation of said stationary triangulation base com- 
prising said at least two spaced-apart signal-producing 
means and the mobile triangle apex, 

11. The system as claimed in claim 10, wherein said 
signal-producing means are four high-intensity light 
sources, attached below water level to the walls of said pool, 
one source to each wall, each source being modulated to a 
different frequency. 

12. The system as claimed in claim 10, wherein said 
signal-detecting means is a direction-sensitive light detector 
mounted on said robot and mechanically coupled to a shaft 
encoder adapted to be rotated by an electric motor. 

13. The system as claimed in claim 10, wherein said 
coupling means includes an umbilical cable for coupling 
said transmission means with said robot for transmitting, by 
means of over-the-power-lines modems, said processed data 
to said microprocessor. 

14. The system as claimed in claim 10, wherein said 
coupling means includes a transformer unit to supply power 
to said robot and said microprocessor means, as well as to 
said signal-producing and detecting means. 

15. The system as claimed in claim 10, wherein said 
coupling means includes a wireless receiver addressable by 
a hand-held wireless remote control unit for manually con- 
trolling said robot. 
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